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In this paper, present the recent advances in bimanual industrial 
manipulators have led to an increased interest in the specific problems 
pertaining to dual arm manipulation. This paper presents a control algorithm 
for dual arm robot that can move the object in a working plane both in 
translation and rotation ways. Different from other research that extend the 


control algorithms for a single robot to a dual arm robot because of fixed 

grasp assumption, this research has considered the frictional contact 
Keywords: constraints to guarantee object grasping during moving of the object. Fast 
terminal sliding mode control (FTSMC) technique is used to design the 
controller and comparison to traditional and super-twisting sliding mode 
controls have been done. Simulations show the effectiveness and 
outperformance of the proposed control algorithm in comparison to 
considered sliding mode control techniques. 
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1. INTRODUCTION 

Due to high flexibility in maneuvring operations, dual arm manipulators exhibit many advantages in 
various applications. Intentionally designated to work in coordinated situations, the dual arm robot experience 
inherent strong kinematic and kinetic couplings making control problems of the robot arms difficult. When 
individual arms synchronously engage a task, the formation of closed-chain dynamics between the robot arms 
and manipulating objects results in complex scenarios for modelling and controlling processes. 

The control problem of dual arm robots has attracted many researchers in recent years [1]. There 
have been many approaches applied to control dual arm robots, from traditional methods such as nonlinear 
feedback control [1], input-output linearization [2], [3], impedance control [4]-[7], hybrid force/motion 
control [8]-[13], to modern methods such as robust-adaptive control and intelligent control [14]-[24]. The 
traditional control methods are general model-based, require the knowledge of the robotic system structure 
and parameters. Thus, they are not effective in cases of model imprecision and unknown robot parameters. In 
order to cope with model uncertainty, intelligent control such as fuzzy control [14], [15] neural network [16], 
reinforcement learning control [17] have been applied to dual arm robot system. In addition, modified sliding 
control [18], intelligent control in combination with sliding mode control [19], [20] also are proposed to 
control dual arm robot. Such types of control techniques are straightforward generalizations from the single 
to multiple manipulator case, since with the assumption of fixed grasps, dynamic model uncertainties affect 
the dynamic response of the controlled system in an analogous fashion in both single and multiple 
manipulator cases. The problem of control dual arm robot becomes more complicated when the grasp 
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conditions are considered as constraints when designing the controllers. Research by Hacioglu et al. [21], 
Nguyen and Vu [22] by using Coulomb law to model the frictional contact constraints, the dynamic model of 
a dual robot arm system has been developed. Then sliding mode control [21] and fuzzy sliding mode control 
[22] are applied to control the system. However, in the research, the dual robot can only translate the object 
in parallel to an axis. To provide flexible maneuvering ability for the dual arm robot, in this paper, an 
algorithm to control the dual arm robot that can manipulate the object with both translational and rotational 
motions using fast terminal sliding mode technique. In addition, fast terminal sliding mode control (FTSMC) 
is formulated to enhance tracking ability, convergent period and robustness against disturbances and then 
compared to traditional and super-twisting sliding mode control [23]-[25] to verify the effectiveness of the 
proposed control algorithm. The comparison analysis is performed based on processor-in-the-loop (PIL) 
simulations. 


2. SYSTEM DYNAMICS 

In this paper, a dual 2-degree of freedom (2DoF) robot system handing an object in a plane is 
considered [23]. The dual arm robot consists of two 2DoF planar robot arms with revolute joints and these 
two robot arms grasp a rectangular object. Figure 1 describes the system, in which, m,;,l; and 
Lj (i = 1,2,3,4) presents the mass, moment of inertia, and length of the related links, respectively; k; is the 
distance from the center of mass of it” link to the preceding joint and 6, is the it” joint angle. In addition, m 
is the object's mass; d4 denotes the width of the rectangle load and d; denotes the distance between the bases 
of the two robot arms. In this system, the viscous frictions acting on all the joints in both robot arms that 
denoted by b; (i = 1, 2, 3, 4) are also considered. It is assumed that the robot arms work in the xy-plane and 
gravity acts in the negative z-direction. 
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Figure 1. Physical model of the dual arm robot 


To establish the dynamical model of the dual robot system, the system is considered as two 
separated robots with external forces at tips of the robots. The external forces are the interactive forces 
between the robot arms and the object as shown in Figure 2. The dynamical equations for the dual robot 
system are described as (1): 


M(4)q+C(G,q) 2 tt J() F -b +w (1) 


where 4 = [6,,0,63,04,]’ is angular vector, t= [t,T;, 154, 7,]| is torque input vector; 
F = [Fix Fiy, Fay, Foy]" is external force vector; b = [b 41, b242,b343,b4q4]" is viscous friction vector 
(by, bz, b3, b, are friction coefficients at dual arm robot joints); w = [W4, W2, W3, w4]" is external disturbance 
torque vector. The external force component can be calculated as (2)-(5): 


Fix = Ficoso + Fsixysing (2) 
Fiy = Fising — Fj44c0sqQ (3) 
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Foy = —F,cosq + Fooyysing (4) 
Fay = —F, sing — FyoxyCosp (5) 


where q is object's rotational angle about z axis; F}, F, are the forces that the robots apply to the object; and 
F;1xy, F;2y are the friction forces between the arm tips and the load surface in xy plane. 

In addition, M (Ẹ) is inertia matrix, C(q,q) is Coriolis matrix, J (Ẹ) is Jacobian matrix, and they are 
calculated as following: 


m4, mu; 0 0 
Lm. M22 0 0 
M(q) = 0 0 mg ma, 
0 0 Mg Myu 


where: | m44 = A, + A, + 243c0505; m4, = Az + A3cos02; M21 = Az + A3c0S02; M22 = A2; M33 = Ay + 
As + 2Agc0s0,; M34 = As + Agcos0,; M43 = As + Agcos0,; M44 = As. 


—A3sin0, (63 + 26,6>) M41 M2 0 0 

MN —440,0,sin8 z n4 n 0 0 
C(4,4) = oe IMG) Sle 

—Agsin0,(02 + 2038,4) T3 N34 

—A6040,sin8, i Oe Rage Mei 


where: n,, = —L4sin0, — L;sin(0, + 05); ni2 = —L;sin(0, + 05); nz, = L4cos0, + L;cos(0, + 

02); n5; = L5cos(0, + 05); N33 = —Lasin04 — L,sin(04 + 04); n44 = —Lysin(O3 + 04); n44 = L4cos04 + 
L4cos(05 + 04); n44 = L4cos(03 + 04). Where A;(j = 1, 2,...,6) are the constant coefficients given by: 

A, =m,k2 + m, + L;A, = m;k2L;A,— mL,k;;A, = m4k2 + m41 + lz; As = m4kz tl; Ag = 
myL3k,. 

Because the dynamical equations of the system contain the interaction forces between the robots and 
the object, it is necessary to determine the interaction forces in case of the system handles the object. As 
shown in Figures 2 and 3, forces F} and F, are exerted from the arm tips to the load at position (x4, y1) and 
(x2, Y2), respectively. The object's center locates at (Xm, Ym) and it is rotated by @ around z-axis. The friction 
forces Fs1xy and Fsz2xy are between the arm tips and the load surface in xy plane. The friction forces F,,, and 
F;,, dedicate the interaction between the arm tips and the load surface along z axis. Since in plane operation 
is considered, it can be supposed that: 


Foz = Fs2z = me (6) 


where g is gravitational acceleration. Using forward kinematics for the two arms, the positions of arm tips 
can be calculated as (7)-(10): 


x% = 2 + L41cos0, + Lacos (01 + 02) (7) 
yı = L,sinO, + L;sin(04 + 02) (8) 
X= 2 + L,cos0@3 + L;cos(05 + 04) (9) 
yı = L,sinO3 + Lzsin(0; + 04) (10) 


Then the object's position can be calculated from robot tips and object's rotational angle as (11): 


Xm = 2 + L4cos0 + Locos (04 + 05) — “cosp =— 2 + L3cos@3 + Lycos (05 + 04) + “ cos (11) 


Ym = l4sin, + Lzsin(0, + 02) — sing = Lssin0s + Lasin(0; + 04) + sing (12) 
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The object obtains the interaction forces F;, F2, Fs1xy» Fs2xy in the xy plane from two robots. Therefore, the 
dynamic equations of the object are: 


MXm = —Ficos$ + F,cosh — Fsixysing — Fe2xysing (13) 

MYm = —Fy sing + Fosing + Fsixycosh + FyoxyCcosp (14) 
m d 

Jọ = (Fsixy — Foxy) > (15) 


from (13) and (14) we can obtain: 

M(Xmsind — \mcosp) = —sin*h(Ferxy + Foxy) — COS? P (Fsixy + Fszxy) (16) 
or: 

Feary + Foaxy = M(Xmsings — Vmcos hs) (17) 


Using (15) and (17) we can calculate the friction forces Fs1xy and F;;,y as (18) and (19): 


Ferry = [M(msind — mcos) + 1] (18) 
Feary = [M(&msind — Jmcosp) - 72 (19) 


Next, we will calculate F}, F;. Substitute (18) and (19) into (13) we obtain: 


AF = F, F, = m Litsin?d)tmtsindcoshIm (20) 


coso 


To handle the object effectively, the following conditions must be satisfied: 


Pie + P3 < (uF,)* (21) 
Bey + F2. < (uF2)* (22) 


where u is dry friction coefficient of the object. Since the direction of the forces F} and F, are always 
perpendicular and toward the object, the friction force equation that results in a positive signed solution for 
both F, and F,should be considered. Therefore, there are two situations corresponding the relation between 
F, and F, needs to be taken into account. In the first case, when F; > F, (i.e. AF > 0), using (21). If the two 
forces are equal, F} and F, can be calculated as (23) and (24): 


1 
F = u E + Bay (23) 


F, =F, + AF (24) 


where F;,,,F;1; and AF are calculated using (18), (6) and (20) respectively. In the second situation, if 
F, < F, (i.e. AF < 0), using (22) with equal case, F, and F, can be calculated as (25) and (26): 


1 
F = u Pow u Eos (25) 
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F, = F — AF (26) 


where Fsz2xy» Fs2z and AF are calculated using (19), (6) and (20) respectively. For summary, the dynamical 
model of the dual arm robot system includes two 2DoF robot arms that handles an object is expressed in (1) 
with external forces F,, Fj, y for the first arm and F3, F;?,,, for the second arm are calculated using (23) (or 


(26)), (18), (24) (or (25)), and (19), respectively. 


m(t)g 


Figure 2. Contact forces between dual robot arm and the object 


Figure 3. Contact forces between dual robot arm and the object in xy plane 


3. FAST TERMILAL SLIDING MODE CONTROL FOR DUAL ARM ROBOT 

In this paper we apply the FTSMC [24] for dual robot arm. The FTMSC is expected to overcome the 
various problems of normal sliding mode control such as asymptotic convergence, chattering. Moreover, the 
converge time of system states to zero can be managed by selecting the appropriate controller parameters. 


3.1. Fast terminal sliding mode control 
Consider a second order nonlinear system as following: 


&i = €; (27) 
êz = f(e) + g(e)u + d(t) (28) 


where e = [e,, e2] is system state vector, f (e), g(e) are smooth functions, d(t) denotes the uncertainties and 
Id (t)| € L, where L is a positive constant. The fast sliding surface is selected as (29): 


S= 21 + Ape, + Roe ts (29) 
where o5, Po and qo, po (do < po) are positive odd numbers. The fast sliding mode controller is designed as (30): 
1 : d 
u(t) = — zc (Fe) + doer + Bo ger”? + gs ys”) (30) 


where ø 0, y » 0 and q,p are positive odd numbers. To confirm the stability of the system with the fast 
sliding mode controller, the Lyapunov function is chosen as (31): 


Fast terminal sliding mode control for dual arm manipulators (Minh Duc Duong) 


yes (31) 
From (29) we have: 
$ =ë, + ages + By Kel’? = f(e) + g(e)u- d(t) + ages + Bo Z ego (32) 


Replace (30) into the above equation, then we have: 


$ = —ọs — ys?/4 + d(t) (33) 
Thus, 

V = s$ = —gs? — ys(4*?/4 + sd(t) (34) 
by choosing y = lon |L, then: 

V2loqgll2aqdO) (35) 


Since q and p are odd numbers, q + p is an even number, then S(4*?/? > 0, Multiple both sides of (35) with 
S (4*?)/? we obtain: 


ys4*?»/4 > sd(t) (36) 
Therefore, 
y = —qs? — ysQtP)/4 + sd(t) < 0 (37) 


The system is asymptotic stable. In addition, from the fast sliding surface (29), it can be seen that the system 
state attain equilibrium e, = 0 from initial state e, (0) # 0 in a finite time ts with: 


=A D l aoe, (0) P0740)/P0 + By 


$ ao(Po-4o) Bo (38) 


Moreover, from the fast-sliding surface (29), when the system is in the sliding surface, i.e. s = 0, we have: 
&4 = —ügei — Bene (39) 


When the state e, is far away from the origin, the convergent time is decided by the fast terminal attraction 


equation é4 = boe” Po. When the state e,approaches the origin e, = 0, the convergent time is determined 
by exponential convergence equation é4 = —age,. Accordingly, the state can converge to equilibrium point 
speedily and precisely. 


3.2. Fast terminal sliding mode control for dual arm robot 
In this section we will design the FTSMC for dual arm robot. From (1) we have: 


å = M-CA, å) * JF -b +3 +w] (40) 


Let the desired angular vector be ĝa = [044, 024,054, 044]. Set new state variables 6&4 = q — qq, @2 = &i. 
Then from (40) we can obtain the system with new state variables as (41) and (42): 


2 =e, (41) 
é.=M*(@)[-C@,q) * J(4) -b+ t w] — da (42) 
like (41) and (42) can be rewritten as (43) and (44): 
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à =6, (43) 
ê, = f (ë) — da + g(&)t + d(t) (44) 


where, é = [€,é2]", f (e) = M (q)[-C(q, d) +J(@)’F — b], g(@) = M*@), and d(t) = Mw. Choose 
the fast-sliding surface as (45): 


5 = à, + age, + Bo e/o (45) 


where Q, Bo and qo, po (do < po) are positive odd numbers. Then, the fast-sliding mode controller for this 
system is, 


1 
g(@) 


- - 2 = d - - - 
T=- — (f(6) — da + aê, + Bo 7-61 + p5 + y5.) (46) 


where ¢ > 0,y > 0 and q,p are positive odd numbers. 


4. PROCESSOR-IN-THE-LOOP BASED SIMULATIONS AND COMPARISON 

To verify the effectiveness of the proposed control method, we preform simulations of the dual arm 
robot in accordance with conventional sliding mode control, super-twisting sliding mode control and the 
proposed FTSMC. In PIL simulation, the controller is embedded in target hardware TI C2000 F38377s. The 
robot parameters (as shown in Figure 1) are given in Table 1. 


Table 1. Robot parameters 


Parameter Value Parameter Value 
Li 0.5 m L; 0.5 m 
L 0.4 m L; 0.4m 
mı 5kg m3 5kg 
m 4kg m4 4kg 
li 0.1 kgm? I; 0.1 kgm? 
L 0.08 kgm? L 0.08 kgm? 
kı 0.25 m ks 0.25 m 
k2 0.2 m k4 0.2m 
b, 100 Ns/m? b; 100 Ns/m? 
b; 100 Ns/m? b4 100 Ns/m? 
d; 0.2 m D» 0.4 m 
m 5kg Object size — 0.2x0.1 m 


The simulation scenario is as following: the first joints of two robots are placed at [0.2; 0] for the first 
robot and [-0.2; 0] for the second robot. The initial joint angle vector is 0 = [0; 37/4; m; —37/4]". Then, the 
initial positions of the first and the second arm's tips are [0.42; 0.28] and [-0.42;0.28] respectively. The object 
has a rectangle form with the center point is located at [0; 0.4]. Initially, to grasp the object, the first arm's tip 
will proceed to [0.1; 0.4] and the second arm's tip will travel to [-0.1; 0.4] as depicted in Figure 4. 

Secondly, the dual arm robot will translate the object's center to [0.2; 0.7] without rotating the 
object. It means that the first arm's tip will move to [0.3; 0.7] and the second arm's tip will move to [0.1; 0.7]; 
as shown in Figure 5. And finally, the robot will drive the object's center point to [0.3; 0.5] while rotate the 
object about 45 degrees. It means that the first arm's tip will move to [0.37; 0.43] and the second arm's tip 
will shift to [0.23; 0.57]; as in Figure 6. To verify the effectiveness of FTSM control, we do the simulation 
for the system with disturbance. Supposing that the disturbance is sinusoidal type vector that is expressed as: 


w = [sin1 Ont sin 2 Ont — sin 1 Ort — sin 20nt]7 


Three control algorithms including SMC, super-twisting and FTSM are applied to the system. The simulation 
results of the system with disturbance are shown in Figures 7-9. It can be seen that the system is stable with 
good position tracking performance. The considered controllers can reject the effect of the disturbance to the 
stability and the system’s performance. Once again, FTSM outperforms the conventional SMC and super- 
twisting slide mode controllers. 
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Figure 4. The begin and the final positions of the dual arm robot in the first stage 


y-axis(m) 


-0.8 -0.6 -0.4 -0.2 0 0.2 0.4 0.6 0.8 
X-axis(m) 


Figure 5. The begin and the final positions of the dual arm robot in the second stage 
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Figure 6. The begin and the final positions of the dual arm robot in the second stage 
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Figure 7. Angular positions of dual arm robot's joints in case of disturbance 
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Figure 9. Object rotation angular error in case of SMC, super-twisting and FTSM control in case of with 
disturbance 
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5. CONCLUSION AND FURTHER STUDY 

In this paper, a position control of a dual arm robot moving an object in a working plane is 
presented. The dynamic of dual arm robot with frictional contact constraint are considered and the FTSMC 
algorithm is developed that allow the robot to both translate and rotate the object. The comparison of the 
proposed controller to traditional and super-twist sliding mode controllers has been done and it is shown that 
the proposed algorithm outperforms the traditional and super-twisting sliding mode controls. In the near 
future, the multi arm robot system to moving object in a 3D space is considered. In addition, experimental 
implementation should be done in order to verify the effectiveness of the proposed control algorithm in the 
real world. 
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